#include"control_cmd/control_cmd_fsm.h"
#include<iostream>

using namespace obstacle_avoid;

int main(int argc, char * argv[])
{
    ros::init(argc,argv,"control_cmd_node");
    ros::NodeHandle nh("~"); //在话题前加上节点名称

    CONTROL_CMD_FSM control_cmd;
    control_cmd.init(nh);

    ros::spin();
    return 0;
}